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® Ermittlungsverfahren fur eine Istgeschwindigkeit eines bewegbaren Verfahrelements 



Mlt einsm Baschleunigungssensor (3) wird eine Bs- 
schleunigung (a), mit einem Lagesensor (2) eines Messla- 
ge (x1) sines Verfahrelements (1) erfasst. Durch Integrie- 
ren bzw. Differenzieren warden eine Modellgeschwindig- 
keit {vM\ bzw. eine Messgeschwindigkeit (v1| ermittelt. 
Anhand der Modellgeschwindigkeit (vM) wird eine Istge- 
schwindigkeit (v) Brmittelt. Die Modellgeschwindigkeit 
(vM) und die Messgeschwindigkeit (v1) warden vonein- 
ender substrahrert. Die Differenz wird einem Roglor ( 1 3) 
mit einem Integralanteil zugefuhrt, dessen Ausgangssi- 
gnal auf die Beschlaunigung (a) aufaddiert wird. 
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Beschreibung 



[0001] Die vorliegende Erflndung betrifft ein Ermittlungs- 
verfahren fllr eine Istgeschwindigkeit eines bewegbaren 
Verfahrelements, 5 

- wobci mittels eines Beschlcunigungsscnsors eine 
Beschleunigung des Verfahrelements erfasst wird und 
durch Integrieren der Beschlcunigung eine Modellge- 
schwindigkeit des Verfahrelements ermittelt. wird, to 

- wobci mittels eines Lagescnsors cine Mcsslagc des 
Verfahrelements erfasst wird und durch Differenzieren 
der Mcsslage eine Messgeschwindigkeit des Verfahr- 
elements ermittelt wird, und 

- wobei anhand der Modellgeschwindigkeit die Istge- is 
schwindigkeit eraiitlelt wird. 

[0002] Ein derartiges Ermittlungsverfahren ist z.B. aus 
"Drehbeschleunigungssensor ermbglicht hochgenaue Dreh- 
zahlregelung" von Lolhar Wilhelmy und Reinhard Domke, 20 
Sonderdruck aus "Antriebsiechnik" 4/99 bekannt. Ein ahnli- 
cher OfTenbarungsgehalt ist dem Aufsatz "Relativbeschleu- 
nigungssensor - Potential und Einsatzmoglichkeiten in der 
Servo-Antriebsteehnik" von W. Hiller, ISW, Stuttgart, ge- 
halten auf dem ISW-Lageregelseminar 1 998, zu entnehmen, 25 
[0003] , Bei derartigen Ermittlungsverfahren muss die er- 
fasste Beschleunigung offsetfrei bleiben, damit die Modell- 
geschwindigkeit nicht wegdriftet. Bei der letztgenannten 
Veroffentlichung wird dies dadurch gclost, dass einem "Be- 
obachter" die erfasste Beschlcunigung und die Mcsslage zu- :» 
gefiihrt werden und der Beobachter daraus einen OfTset fur 
die erfasste Beschleunigung ermittelt, der dann eliminiert 
wird. In dieser Schrift ist weiter beilaufig als Alternative der 
Aufbau ciner untcrlagcrtcn Bcschlcunigungsrcgclschlcife 
erwahnl. 35 
[0004] Die Aufgabe der vorliegenden Erflndung besteht 
darin, ein Ermittlungsverfahren der eingangs genannten Art 
zu schaffen, bei dem cine moglichst cinfachc und dennoch 
hochgenaue Kompensation eines elwaigcn Beschleuni- 
gungsoffsets moglich ist. 40 
[0005] Die Aufgabe wird dadurch gelost, dass die Modell- 
geschwindigkeit und die Messgeschwindigkeit voncinandcr 
subtrahiert werden und die Differenz einem Regler mit ei- 
nem Integralanteil, insbesondere einem PI-Regler, zugefuhrt 
wird, dessen Ausgangssignal auf die Beschlcunigung aufad- 45 
dicrt wird. 

[0006] Wenn die Modellgeschwindigkeit dem Regler mit 
einem Integralanteil zeitverzogert zugefuhrt wird, ist die 
Offsctkompcnsation mit hohcrcr Rcgcldynamik durchfuhr- 
bar. SO 
[0007] Wenn der Regler rait einem Integralanteil im Peld 
einstellbare Reglerparameter aufweist, sind die Reglerpara- 
mcter im Fold an die dort konkret gcgcbcncn Umslandc an- 
pafSbar. 

[0008] Wenn durch Integrieren der Istgeschwindigkeit 55 
eine Modelllage und anhand derModelllage eine Istlage er- 
mittelt wird, kann anhand der Beschleunigung auch die Ist- 
lage berechnet werden, 

[0009] Wenn die Istlage und die Messlage voneinander 
subtrahiert werden und die Differenz. einem P-Regler zuge- 60 
fuhrt wird, dessen Ausgangssignal auf die Istgeschwindig- 
keit aufaddiert wird, ist auch die Istlage offsetfrei ermillel- 
bar. 

[0010] Wenn die Istlage gegeniiber der Modelllage zeit- 
verzogert ist, arbeitct die Regelung genauer. 6s 
[0011] Wenn der P-Regler im Feld einstellbare Reglerpa- 
rameter aufweist, sind die Reglerparameter im Feld an die 
dort konkret gegebenen Umstande anpaSbar. 



[0012] Weitere Vorteile und Einzelheiten ergeben sich aus 
der nachfolgendon Beschreibung eines Ausflihrungsbei- 
spicls. Dabci zeigen in Prinzipdarstellung 
[0013] Fig, 1 eine Regelanordnung mit einem Verfahrele- 
ment und 

[0014] Fig. 2 die innere Siruklur der Regelanordnung von 
Fig. 1. 

[0015] GemaB Fig, 1 wird ein Bewegen eines Verfahrele- 
ments 1 sowohl mittels eines Lagesensors 2 als auch mittels 
eines Beschleunigungssensors 3 erfasst. Der Lagesensor 2 
erfasst dabci eine Messlage xl, der Beschleunigungsscnsor 
3 eine Beschleunigung a. Die Beschleunigung a und die 
Messlage xl konnen dabei wahlweise Lineare oder rotatori- 
sche GroBen sein. 

[0016J Die Beschleunigung a und die Messlage xl werden 
einer Regelanordnung 4 zugefuhrt. Die Regelanordnung 4 
kann ein Haidwareregler sein. Vorzugsweise aber ist die Re- 
gelanordnung 4 ein Softwareregler, der ein Computerpro- 
grammprodukl 5 abarbeitel. In diesem Fall ist die Regelan- 
ordnung 4 mil. dem Computerprogrammprodukt 5 program- 
nriert und arbeitet entsprechend der Programmierung durch 
das Computerprogrammprodukt 5. 
[0017] Die Regelanordnung 4 ermittelt anhand der u'ber- 
mittelten Beschleunigung a und/oder der ubermittelten 
Messlage xl eine Istgeschwindigkeit v und vergleicht diese 
mit einer Sollgeschwindigkeit v*. Die Regelanordnung 4 re- 
gelt dann das Verfahrelement 1 derart nach, dass die Istge- 
schwindigkeit v der Sollgeschwindigkeit v* angeglichen 
wird. 

[0018] GcmalJ Fig, 2 wird die Beschlcunigung a liber ei- 
nen ersten Additionspunkt 6 einem ersten Integrator 7 zuge- 
fuhrt, Dieser integriert das ihm zugefilhrte Signal und ermit- 
telt so durch Integrieren der Beschleunigung a eine Modell- 
geschwindigkeit vM. Die Modellgeschwindigkeit vM wird 
als Istgeschwindigkeit v herangezogen. Sie wird iiber einen 
zweiten Additionspunkt 8 einem zweiten Integrator 9 zuge- 
fiihrt. Dieser ermittelt durch Integrieren der Istgeschwindig- 
keit v eine Modelllage xM und gtbt dicse aus. Dem zweiten 
Integrator 9 ist ein erster Verzogerer 10 nachgeordnet, so 
daB das Ausgangssignal des ersten Verzogerers 10 der Ist- 
lage x entspricht. 

[0019] Die Mcsslagc xl wird einem Diffcrcnzicrcr 11 zu- 
gefiihrt, der durch Differenzieren der Messlage xl eine 
Messgeschwindigkeit vl des Verfahrelements 1 ermittelt. 
Die Messgeschwindigkeit vl und die Modellgeschwindig- 
keit vM werden einem ersten Subtraktionspunkt 12 zuge- 
fuhrt. Dort werden die Modellgeschwindigkeit vM und die 
Messgeschwindigkeit vl voneinander subtrahiert. Die Dif- 
ferenz wird cincm ersten Regler 13 zugefuhrt. Dessen Aus- 
gangssignal wird dem ersten Additionspunkt 6 zugefuhrt 
und so ein etwaiger Offset der gemessenen Beschleunigung 
a kompensiert. Die Modellgeschwindigkeit vM wird dem 
ersten Subtraktionspunkt 12 iiber einen zweiten Verzogerer 
14 zugefuhrt, so dass im ersten Regler 13 mil gleichen Zei- 
ten korrespondierende GroBen vM, vl miteinander vergli- 
chen werden. 

[0020] Die Messlage xl und die Istiage x werden einem 
zweiten Subtraktionspunkt 15 zugefuhrt. Dort werden die 
Istlage x und die Messlage xl voneinander subtrahiert. Die 
Differenz wird einem zweiten Regler 16 zugefuhrt, dessen 
Ausgangssignal iiber den zweiten Additionspunkt 11 auf die 
Istgeschwindigkeit v aufaddiert wird. 
[0021] Der erste Regler 13 ist als PI-Regler ausgebildet. 
Er weist daher mindestens zwei Reglerparameter auf, nam- 
lich cine Proportionalvcrstarkung PV1 und eine Intcgralver- 
starkung IV. Insbesondere weist er somit einen Integralanteil 
auf. Der zweite Regler 16 ist als P-Regler ausgebildet. Er 
weist daher mindestens einen Reglerparameter auf, namlich 
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cine zweite Proportionalverstarkung PV2. 
[0022] Um die Regelanordnung 4 moglichst flexibel ein- 
sctzcn zu konncn, sind die Reglerparameter PV1, PV2, IV 
im Feld einstellbar. Dies ist in Fig. 2 durch entsprechende 
Pfeile zu den Reglern 13, 16 angedeutet. Als besonders vor- 
teilhaft hat sich erwiesen, wenn die Reglerparameter PV1 , 
IV des crsten Regions 13 dcrart gcwahlt werden, dass einc 
Regelabweichung nach ftinf bis lausend, insbesondere nach 
einhundert bis dreihundert, Systemtakten ausgeregelt ist. 
[0023] Aufgrund der Ausbitdung des ersten Reglers 13 als 
PI-Rcglcr rcgclt dieser jeden auch noch so geringen Offset 
des Beschleunigungssensors 3 zu Null. Slalionar kann daher 
im Integrationszweig kein Geschwindigkeitsoffset entste- 
hen. Aus dicsem Grand ist die Ausbildung des zweiien Reg- 
lers 16 als P-Regler hinreichend. 

[0024] Mit dem erfindungsgemafien Ennittlungsverfahren 
bzw. der enfindungsgemiilien Regelanordnung 4 ist auf ein- 
fache Weise eine hochgenaue Geschwindigkeitsregelung 
des Verfahrelemenls 1 moglich, ohne dass die Gefahr eines 
Wegdriftens der aus der Beschleunigung a abgeleiteten Mo- 
dellgeschwindigkeit vM bestcht 



Ermittlungsverfahrens nach einem der Ansprliche 1 bis 
7. 

9. Regelanordnung zur Durchfuhrung des Ermitt- 
lungsverfahrens nach einem der Anspriiche 1 bis 7. 

10. Regelanordnung nach Anspruch 9, dadurch ge- 
kennzeichnet, dass sie mit einem Computerprogratmn- 
produkt (5) nach Anspruch 8 programmiert ist. 
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Patentanspriiche 

1. Ermittlungsverfahren fur eine Istgeschwindigkeit 25 
(v) eines bewegbaren Verfahrelements (1), 

wobei miltsls eines Beschleunigungssensors (3) eine 
Beschleunigung (a) des Verfahrelements (1) erfasst 
wird und durch Tntegrieren der Beschleunigung (a) eine 
Modellgeschwindigkcit (vM) des Verfahrelements (1) 30 
ermiltelt wird, 

wobei mittels eines Lagesensors (2) eine Messlage (x 1 ) 
des Verfahrelements (1) erfasst wird und durch Diffe- 
renzieren der Messlage (xl) einc Mcssgcschwindigkeit 
(vl) des Verfahrelements (1) ermittelt wird, 35 
wobei anhand der Modellgeschwindigkcit (vM) die Ist- 
geschwindigkeit (v) ermittelt wird, und 
wobei die Modellgeschwindigkcit (vM) und die Mcss- 
geschwindigkeit (vl) voneinander subtrahiert werden 
und die Differenz einem Regler (13) mit einem Inte- 40 
gralanteil, insbesondere einem PI-Regler (13), zuge- 
fiihrt wird, dessen Ausgangssignal auf die Beschleuni- 
gung (a) aufaddiert wird. 

2. Ermittlungsverfahren nach Anspruch 1, dadurch ge- 
kennzeichnet, dass die Modellgeschwindigkcit (vM) 45 
dem Rcglcr (13) mit einem Integralanteil zeitverzogert 
zugefllhrt wird. 

3. Ermittlungsverfahren nach Anspruch 1 oder 2, da- 
durch gekennzeichnet, dass der Rcglcr (13) mit einem 
Integralanteil im Feld einstellbarc Reglerparameter so 
(PVl.IV)aufweist. 

4. Ermittlungsverfahren nach Anspruch 1, 2 oder 3, 
dadurch gekennzcichnet, dass durch Intcgrieren der Ist- 
geschwindigkeit (v) eine Modelllage (xM) und anhand 
der Modelllage (xM) eine Istlage (x) ermittelt wird. 55 

5. Ermittlungsverfahren nach Anspruch 4, dadurch ge- 
kennzeichnet, dass die Istlage (x) und die Messlage 
(x 1) voneinander subtrahiert werden und daB die Diffe- 
renz einem P-Regler (16) zugefuhrt wird, dessen Aus- 
gangssignal auf die Istgeschwindigkeit (v) aufaddiert 60 
wird. 

6. Ermittlungsverfahren nach Anspruch 4 oder 5, da- 
durch gekennzeichnet, dass die Istlage (x) gegenuber 
der Modelllage (xM) zeitverzogert wird. 

7. Ermittlungsverfahren nach Anspruch 4, 5 odor 6, 65 
dadurch gekennzeichnet, dass der P-Regler (16) im 
Feld einstellbarc Reglerparameter (PV2) aufweist, 

8. Computerprogrammprodukt zur Durchfuhrung des 
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